uint32 index
geometry_msgs/PoseStamped goal
uint16 error_code
